import lejos.nxt.Button;
import lejos.nxt.LCD;
import lejos.nxt.MotorPort;
import lejos.nxt.NXTMotor;
import lejos.nxt.SensorPort;
import lejos.nxt.UltrasonicSensor;

public class TestRotator {
	
public static void main(String[] args) throws Exception {
		
		NXTMotor mot = new NXTMotor(MotorPort.B);
	
		UltrasonicSensor s = new UltrasonicSensor(SensorPort.S2);
	
		mot.resetTachoCount();
		mot.setPower(50);
		mot.forward();
		LCD.drawString("Deg: " + mot.getTachoCount(), 0, 1);
		Button.ENTER.waitForPressAndRelease();
		mot.stop();
		LCD.drawString("Deg: " + mot.getTachoCount(), 0, 1);
		while(true)
			LCD.drawString("Dist: " + s.getDistance(), 0, 2);
	}
	
	
}
